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This  thesis  conducts  a  state-space  analysis  of  the  Mark 
6  gyro  used  in  the  Trident  II  missile  system.  Optimal 
control  techniques,  utilizing  a  region  controller,  have  been 
employed  in  designing  a  gyro  controller.  The  response  of 
the  system  to  missile  motion  is  examined  and  compared  to  the 
system  response  using  the  current  control  laws.  It  is  shown 
that  an  optimal  region  controller  reduces  the  gyro  error  in 
the  system  while  effectively  avoiding  gimbal  lock,  a  situ¬ 
ation  which  exists  when  gyro  orientation  prevents  missile 
motion  from  being  isolated  in  an  orthogonal  three  axis  coor¬ 
dinate  system.  Recommendations  for  the  applicatii^  of  addi¬ 
tional  modem  control  techniques  are  included.  ^  ,  ,,.r  ,  / 
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I.  INTRODUCTION 


A  need  for  accurate,  self-contained  navigation  systems 
has  existed  since  the  early  days  of  aircraft  design.  The 
most  common  of  these  systems  uses  accelerometers  to  deter¬ 
mine  body  motion.  The  output  signal  is  integrated  once  to 
obtain  velocity  and  again  to  obtain  position. 

In  order  for  the  navigation  system  to  accurately  deter¬ 
mine  body  motion  the  sensors  must  be  mounted  on  a  platform 
fixed  in  a  known  coordinate  system.  In  ballistic  missile 
guidance  systems,  gyros  are  used  to  fix  a  platform  in  iner¬ 
tial  space.  The  accelerometers  are  mounted  on  this  plat¬ 
form.  The  purpose  of  the  gyro  controller,  then,  is  to 
generate  the  gyro  torque  motor  commands  necessary  to  main¬ 
tain  the  stable  platform  fixed  in  inertial  space. 

Since  1957,  the  Charles  Stark  Draper  Laboratory  in 
Cambridge,  Massachusetts  has  designed  the  gyros  for  the 
Navy's  Polaris,  Poseidon  and  Trident  missiles.  Because  of 
the  complex,  highly  non-linear  nature  of  the  control  system, 
this  design  process  has  been  a  tedious,  iterative  affair. 
Using  state-space  representation  of  systems,  computer-aided 
optimal  control  design  techniques  greatly  simplify  the 
multi-input,  multi-output  non-linear  time  varying  problem. 
The  goal  of  this  thesis  is  the  development  of  a  state- space 
model  of  the  Trident  II  gyro  system,  the  Mark  6,  and  the 
application  of  modern  control  theory  to  improve  system 
performance . 

A  state- space  model  of  the  system  has  been  developed  and 
is  compared  to  the  current  gyro  model.  Transient  response 
of  both  systems  to  missile  motion  is  examined.  Modem 
control  techniques  using  optimal  feedback  gains  are  employed 
to  minimize  gyro  errors  and  improve  system  response.  The 
choice  of  optimal  feedback  gains  is  made  based  on  a  region 


controller  which  selects  the  gains  dependent  upon  the 
particular  gimbal  angles.  Finally,  suggestions  are  made  for 
employing  modem  control  techniques  to  further  optimize 
system  performance. 


II.  FUNCTION  OF  THE  GYRO  CONTROLLER 


A.  THE  ALL- ATTITUDE  GIMBAL  ASSEMBLY 

The  inertial  navigation  system  for  a  ballistic  missile 
must  accurately  determine  missile  motion  in  three  orthogonal 
planes.  Missile  motion  is  resolved  by  accelerometers 
mounted  on  a  platform  fixed  in  inertial  space.  A  three 
dimensional  coordinate  system  is  initialized  before  missile 
launch,  and  remains  fixed  through  out  the  flight.  The  func¬ 
tion  of  the  gyro  controller  is  to  keep  the  stable  platform 
fixed  throughout  the  flight. 

The  Mark  6  gyro  consists  of  four  concentric  gimbals  as 
shown  in  Figure  2.1  [Ref.  1:  p.  2].  The  innermost  gimbal  is 
the  stable  platform,  housing  the  accelerometers.  As  the 
missile  experiences  pitch,  roll  and  yaw  a  torque  is  applied 
to  the  gimbals  in  such  a  manner  as  to  isolate  the  stable 
member  from  the  motion. 

1 .  Gimbal  Lock 

In  addition  to  maintaining  a  fixed  inertial  refer¬ 
ence,  the  gyro  controller  must  prevent  "gimbal  lock".  This 
occurs  when  the  gimbals  are  co-planar  and  it  becomes  impos¬ 
sible  to  isolate  missile  motion  on  three  orthogonal  axes. 
Controlling  the  gyro  errors  is  relatively  straightforward, 
while  preventing  gimbal  lock  is  more  complex.  Since  the 
gimbal  angles  can  assume  any  value  during  missile  flight, 
the  problem  becomes  non-linear  and  difficult  to  solve.  The 
technique  developed  by  Draper  Laboratory  for  preventing 
gimbal  lock  will  be  employed  in  the  design  of  the  state- 
space  system  model.  This  technique  is  more  fully  described 
in  the  next  chapter. 

2 .  Missile  to  Stable  Member  Motion  Coupling 

The  four  gimbal  IMU  model  is  shown  in  Figure  2.2 
[Ref.  2:  p.  2].  Missile,  or  base  motion  occurs  in  the 
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Figure  2.1  Four  Gimbal  Gyro  Model. 

^5 ’-^5 ’^5  coordinate  system.  This  motion  is  coupled  to  the 
stable  member  coordinate  system  t>y  the  outer, 

middle  and  inner  gimbals.  The  system  accuracy  is  measured 
by  the  gyro  error  of  the  stable  member  in  the 
space.  Appendix  B  contains  the  detailed  transformation  of 
missile  motion  in  the  base  frame  of  reference  to  motion  in 
the  inertial  frame. 
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III.  MARK  6  GYRO  MODEL 


A.  BLOCK  DIAGRAM 

The  Mark  6  Gyro  model  presently  being  used  by  Draper 
Laboratory  is  shown  in  Figure  3.1  [Ref.  2:  p.  8].  Table  III 
in  Appendix  A  contains  a  definition  of  abbreviations  used  in 
this  thesis.  The  torque  motor  commands  are  the  inputs  to 
the  system,  with  the  gyro  errors  and  gimbal  angles  as  the 
output.  The  diagram  illustrates  the  cross-coupling  between 
gimbals  represented  by  the  input  equations  shown  in  Figure 

B. l. 

1.  Plant  Diagram 

a.  Signal  Conversions 

Figure  3.1  contains  the  electrical  and  mechan¬ 
ical  realizations  of  the  Mark  6  gyro.  The  input  signal  is 
expressed  in  terms  of  quanta,  with  one  quanta  equal  to 
0.0735  volts.  The  torque  command  is  expressed  in  ounce- 
inches  .  The  gimbal  angles ,  given  in  radians ,  are  converted 
to  quanta  for  input  to  the  feedback  controller. 

b .  RGyro 

Also  shown  on  the  diagram  is  the  RGyro.  This  is 
not  a  part  of  the  plant.  The  RGyro  defines  an  error  associ¬ 
ated  with  the  roll  axis.  In  earlier  three  gimbal  gyros,  the 
roll  axis  of  the  missile  did  not  coincide  with  any  of  the 
gimbal  axes.  The  four  gimbal  Mark  6  gyro  aligns  the  roll 
axis  with  the  outer  gimbal  axis,  thus  eliminating  the  need 
for  the  RGyro  as  an  indication  of  gyro  error.  The  output  is 
still  provided  for  ease  in  comparing  current  model  errors 
with  previous  systems. 

c.  Gimbal  Inertias 

The  gimbal  inertias  are  represented  in  Figure 


3.1  as  J< 


Jl,  Jf.]  and  Jq  for  the  stable  member  and  inner. 


middle  and  outer  gimbals  respectively.  The  outer  and  middle 
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gimbal  inertias  change  with  time  as  a  function  of  the  inner 
gimbal  angle.  Figure  3.2  shows  how  the  inertias  are 
resolved  [Ref.  2:  p.  6]. 


d.  Stable  Element 

The  stable  member  is  represented  by  the  upper 
flow  path  in  Figure  3.1.  There  are  no  external  inputs  to 
the  stable  member,  with  only  friction  affecting  the  loop. 
The  stable  element  is  controlled  by  its  own  feedback  loop 
and  is  not  influenced  by  the  other  system  signals.  Signals 
from  the  stable  loop  do  cross-couple  to  the  other  gimbals, 
however,  with  the  torque  command  coupling  to  the  middle  and 
outer  gimbals.  The  inertial  rate  S  serves  as  an  input  to 
the  stable  member  angle,  shown  at  the  bottom  of  the  figure. 
This  angle  could  also  be  shown  connected  to  the  stable 
element  flow  path,  with  an  input  from  the  outer  gimbal  iner¬ 
tial  rate.  Because  the  stable  member  is  affected  only  by 
friction,  it  has  not  been  included  in  the  state- space  model. 

e.  Sampling  Rates 

Two  different  sampling  rates  are  used  in  the 
system.  The  U,  V  and  W  gyros  are  sampled  at  300  Hz.  The 
gimbal  angles  are  sampled  at  100  Hz. 

f.  Gimbal  Lock  Avoidance 

The  proximity  of  the  system  to  gimbal  lock  can 
be  measured  by  observing  the  sines  of  the  inner  and  middle 
angles.  The  product  SIN(Aj)*SIN(Aj.j)  gives  an  indication  of 
how  close  the  system  is  to  gimbal  lock,  with  gimbal  lock 
occuring  when  the  product  equals  one.  The  goal  of  gimbal 
lock  avoidance  is  to  drive  the  product  of  the  sines  to  zero. 
This  is  accomplished  by  setting  either  the  inner  or  middle 
angle  to  0  or  180  degrees. 

Only  one  angle  need  be  controlled  at  a  time. 
Figure  3.3  shows  the  regions  where  control  would  switch  from 
one  angle  to  another.  This  is  based  on  the  smallest  of  the 
absolute  values  of  the  sines. 

The  missile  motion  input  to  the  U  and  V  gyros 
has  a  gain  factor  of  SIN(Aj.j)*SIN(Aj) ,  as  seen  in  Figure  3.1 
Thus,  in  addition  to  avoiding  gimbal  lock,  nulling  the 
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Figure  3.3  Gimbal  Lock  Avoidance  Switching  Line. 

product  of  the  sines  of  the  inner  and  middle  gimbal  angles 
also  minimizes  the  effect  missile  motion  has  on  gyro  error. 

2 .  Gyro  Controller 
a.  Control  Laws 

Figure  3.4  shows  the  controller  for  the  Mark  6 
gyro  [Ref.  3:  p.  115].  The  six  inputs  to  the  controller  are 
the  three  signals  generated  from  the  U,V  and  W  gyros,  the 
stable  element  gimbal  angle  and  the  sines  of  the  inner  and 
middle  gimbal  angles.  The  four  outputs  are  the  torque  motor 
command  signals. 


b.  Transfer  Functions 

The  transfer  function  H^(z)  in  the  stable 
element,  inner  and  middle  gimbal  feedback  paths  is  defined 
as : 

Hi(z)  =  (z-.932)3(z-.80955)/(z-1)2(z-.6186)(z-. 17474) 

The  transfer  functions  H2(z)  and  H3(z)  in  the 
outer  gimbal  control  loop  are: 

H2(2)  =  (z-.9778)/(z+.3827) 

H3(z)  =  (z-l)/z 

c.  Redundant  Torque 

The  outer  gimbal  control  loop  has  three  inputs 
controlled  by  switches  Q3^,Q2  and  Q3.  Two  of  the  inputs  are 
the  SIN(^)  and  SIN(A]-)  signals.  The  third  input  is  the 
stable  element  angle.  The  two  signals  generated  by  this 
loop  are  necessary  when  the  product  SIN(^)*SIN(Aj)  becomes 
very  small  and  does  not  produce  a  large  enough  error  signal 
to  drive  the  outer  gimbal.  and  Q3  are  switches  with 

values  of  +1  and  -1  depending  on  gimbal  geometry.  Switch  Q2 
is  closed  for  values  of  SIN(Aj^)^SIN(Aj)  less  than  1/8,  and 
open  for  values  greater  than  1/8. 

d.  Scaling  Factors 

Gain  blocks  with  2^^  and  1/2^^  scaling  factors 
are  included  in  the  control  laws.  These  gain  factors  are 
applied  in  order  to  facilitate  software  processing  of  the 
feedback  signals  only. 


IV.  STATE -SPACE  MODEL 


A.  BLOCK  DIAGRAM 

1.  Plant  Model 

The  state- space  model  of  the  Mark  6  Gyro  is  shown  in 
Figure  4.1.  Where  appropriate,  the  gains  from  Figure  3.1 
have  been  combined  into  a  single  block.  Only  the  inner, 
middle  and  outer  gimbals  have  been  modeled.  Eight  states 
are  identified  on  the  figure. 

2 .  Assumptions  and  Simplifications 

A  number  of  assumptions  and  simplifications  have 
been  made  in  order  to  develop  the  state- space  model: 

(a)  there  is  no  friction  (this  eliminates  the  stable 
element  loop) 

(b)  all  scates  are  available  for  feedback 

(c)  the  inner  and  middle  anjgles  are  fed  back  directly, 
not  the  sines  of  the  angles 

(d)  there  are  no  limiters  in  the  system 

(e)  the  entire  system  is  sampled  at  300  Hz 

3 .  State- Space  Equations 

The  state- space  equations  of  the  system  are  in  the 

form; 

x(t)  =  A(t)x(t)  +  B(t)u(t) 

The  vectors  x(t)  and  u(t)  are  described  in  Table  I. 
A(t)  and  B(t)  are  the  plant  and  control  matrices,  respec¬ 
tively.  The  matrices  for  this  system  are  shown  in  Figure 
4.2. 
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TABLE  I 

STATE  AND  CONTROL  VECTORS 


inner  gimbal 

inertial  rate  I 

*2 

U  Gyro  error 

*3 

inner  gimbal 

angle  Aj^ 

X4 

middle  gimbal 

inertial  rate  M 

*5 

V  Gyro  error 

*6 

middle  gimbal 

angle 

*7 

outer  gimbal 

inertial  rate  0 

*8 

stable  element  gimbal  angle 

inner  gimbal 

torque  signal 

U2 

middle  gimbal 

torque  signal 

“3 

outer  gimbal 

torque  signal 

Plant  Matrix 


0 


-KCs 

1 

0 

KSg 

0 

0 

0 


0 

0 

0 

0 

0 

0 

0 

0 


where  K 


0  0 

0  KCjSg 

0  0 

0  0 

0  -KCjCg 

0  1 

0  0 

0  -Sj 

1,077,470 


0 

0 

0 

0 

0 

0 

0 

0 


0  0  0 

0  -KSiC„Sg  0 

0  0  -S„ 

0  0  0 

0  KCgSjCj^  0 

0  0  0 

0  0  0 
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Figure  4.2  Plant  and  Control  Matrices  for  State- Space  Model 


V.  OPTIMIZATION  TECHNIQUE 

A.  OPTIMAL  REGULATOR 

1 .  Linear  Quadratic  Problem 

The  Mark  6  gyro  model  can  be  represented  by  the 
state  differential  equation 

x(t)  =  A(t)x(t)  +  B(t)u(t) 

The  goal  of  the  optimization  technique  is  to  drive 
the  system  to  the  desired  state  as  quickly  as  possible, 
while  using  only  practical  input  amplitudes.  The  quadratic 
integral  criterion  can  be  used  to  express  how  rapid  an 
initial  state  is  driven  to  the  final  state  [Ref.  4:  p.  201]. 
This  criterion  can  be  expressed  as: 

J  =  Jx'^(t)R3(t)x(t)dt 

R3(t)  is  an  appropriate  weighting  matrix  chosen  to 
minimize  the  output  state  vector.  The  criterion  as  repre¬ 
sented  above  would  require  very  large  input  amplitudes , 
usually  unattainable  in  a  practical  system.  Including  the 
input  in  the  quadratic  integral  yields 

J  =  J'[x^(t)R3(t)x(t)  +  u’^(t  )R2(t  )u(t  )]dt 

By  proper  selection  of  R2  and  R3 ,  the  output  vector 
can  be  minimized  using  realizable  input  amplitudes. 

Since  only  the  controlled  variables  are  of  interest, 
the  cost  equation  can  be  written  in  terms  of  the  output 
vector  z(t),  given  as: 

z(t)  =  D(t)x(t) 


A  weighting  matrix  Rj^  can  now  be  defined  as: 
Rl(t)  =  DT(t)R3(t)D(t) 


R]^(t)  is  a  square,  positive  semi-definite  symmetric 
matrix  having  the  same  order  as  the  number  of  controlled 
variables  of  the  system.  The  selection  of  the  specific 
values  for  and  R2  are  discussed  in  the  next  section. 

The  inputs  for  the  Mark  6  gyro  are  the  signals  to 
the  torque  motors.  These  signals  are  generated  solely  as  a 
function  of  gyro  error  and  gimbal  angular  position.  In  the 
optimal  regulator  problem,  the  inputs  can  be  expressed  in 
terms  of  an  optimal  feedback  gain  matrix  and  the  states. 

u(t)  =  -Fx(t) 

The  state  differential  equation  can  then  be  written 


x(t)  =  A(t)x(t)  +  B(t)(-Fx(t))  +  B(t)uQ(t) 

When  there  are  no  external  inputs,  UQ(t)=0. 
Combining  terms  yields  the  following: 

x(t)  =  [A(t)-B(t)F(t)]x(t) 

In  the  linear  quadratic  problem,  the  control  law  can 
be  expressed  as: 

u(t)  =  -R2"^B'^Px(t) 

The  optimal  feedback  gain  matrix  now  becomes: 

F  =  R'^b'^P 


tion: 


The  matrix  P  is  found  by  solving  the  Riccati  equa¬ 


-  IuTt 


PA  +  A^P  -  PBRn  "-B^P  +  R 


This  is  the  solution  for  the  steady-state  optimal 
feedback  gains,  and  is  the  method  used  to  develop  the  feed¬ 
back  gain  matrices  used  to  control  the  Mark  6  gyro. 


2.  Choice  of  Weighting  Matrices 


The  weighting  matrices  and  R2  were  chosen  based 
on  the  maximum  values  that  the  output  vector  and  inputs 
could  be  expected  to  reach.  When  the  weighting  matrices 
have  values  only  on  the  diagonal,  the  matrix  product  x'^Rx 
becomes  for  each  of  the  values  of  x.  R^^  is  then 
set  equal  to  the  inverse  of  the  maximum  expected  value  of  x^^ 
squared.  This  drives  each  of  the  terms  in  the  cost  equation 
to  one  when  their  value  approaches  the  maximum  allowed,  and 
to  zero  when  their  value  is  small. 

3 .  Non-zero  Steady  State  Outputs 

The  solution  to  the  linear  quadratic  optimal  feed¬ 
back  gain  problem  has  been  outlined  in  the  previous 
sections.  This  solution  assumes,  however,  that  the  desired 
steady-state  value  of  the  controlled  states  is  zero.  Since 
the  Mark  6  control  law  includes  nulling  the  sine  of  the 
inner  or  middle  angle,  it  is  possible  that  the  desired  value 
of  the  inner  or  middle  angle  be  180  degrees,  not  0.  In  this 
case,  the  optimal  feedback  gain  control  law  becomes: 

u(t)  =  -F[-R+x(t)] 

The  vector  R  here  represents  the  reference  signal  in 
the  system,  as  shown  in  Figure  5.1.  When  R=0,  the  optimal 
control  solution  reduces  to  that  shown  above. 

In  addition  to  an  axis  shift,  driving  the  system  to 
a  non- zero  set  point  can  also  be  accomplished  by  adding  a 
constant  factor  u^  to  the  control  input  u(t).  The  control 
input  then  becomes : 

u(t)  =  -Fx(t)  +  Uq 

A  Uq  can  be  chosen  such  that  when  the  system  experi¬ 
ences  a  shift  in  the  set  point,  as  the  gyro  controller  does 
when  shifting  from  0  to  180  degrees,  an  optimal  response  is 
obtained  while  remaining  within  allowable  input  amplitudes. 
[Ref.  4:  pp. 270-275]. 


Figure  5.1  Optimal  Gain  Feedback  Block  Diagram. 

This  optimal  constant  input  is  defined  as: 

Uo  =  H<.-l(0)Zo 

In  this  equation,  Hg(s)  is  the  closed  loop  transfer 
function  from  the  inputs  to  the  desired  non- zero  steady 
state  output  z^.  The  use  of  this  solution  requires  that  the 
number  of  inputs  is  equal  to  the  number  of  outputs,  and  that 
the  inverse  of  transfer  function  Hj,(s)  exists.  If  the 
transfer  function  has  any  zeros  at  the  origin,  the  matrix 
Hj,(0)  is  singular  and  the  inverse  does  not  exist. 

The  optimal  solution  for  the  gyro  controller  gener¬ 
ates  one  or  more  zeros  at  the  origin  depending  on  the 
particular  gimbal  angles.  Thus,  the  optimal  input  u^  cannot 
be  found  and  the  axis  shift  technique  must  be  used. 

B.  MARK  6  GYRO  OPTIMAL  CONTROLLER 
1 .  Region  Controller 

With  a  sampling  rate  of  300  Hz,  computing  the 
optimal  feedback  gains  every  sampling  interval  would  require 
an  enormous  amount  of  computations.  Lauro  has  shown  that  a 
region  controller  will  yield  a  nearly  optimal  response  while 
greatly  reducing  the  calculations  involved  [Ref.  1;  p.  8]. 


The  plant  and  control  matrices  of  the  Mark  6  gyro  are  a 
function  of  the  gimbal  angles,  which  in  turn  vary  with  time. 
The  optimal  regulator  designed  for  the  system  divides  the 
gimbal  angle  regions  up  into  segments  of  30  degrees  or  less. 
Optimal  gains  for  the  gimbal  angles  at  the  center  of  the 
region  have  been  calculated.  When  the  missile  motion  causes 
the  gimbal  angles  to  change  from  one  region  to  another,  the 
controller  inserts  the  feedback  gains  calculated  for  that 
region.  Figure  5.2  shows  typical  regional  divisions  for  two 
angles.  The  regions  are  10  degrees  wide  near  zero,  and  30 
degrees  wide  further  from  the  origin.  The  figure  shows  a 
two  dimensional  plot,  although  the  actual  gyro  controller 
involves  four  angles  in  four  dimensional  space. 


Figure  5.2  Region  Controller  Segments. 

Figure  5.3  contains  the  algorithm  of  the  computer 
program  written  to  implement  the  optimal  regulator.  A  copy 
of  the  program  listing  is  included  in  Appendix  C. 


% 

initialize  missile  motion  and  gyro  rates  to  zero 

assign  initial  gimbal  angles 

determine  initial  condition  vector  x(0) 

restrict  all  angles  to  +/-  360  degrees 

determine  optimal  gain  region  based  on  gimbal  angles 

assign  appropriate  optimal  feedback  gains 

calculate  variable  terms  in  plant  and  control  matrices 

input  missile  motion 

calculate  x(k+l)  values  for  each  state 

Figure  5.3  Algorithm  for  the  Mark  6  Gyro  Optimal  Regulator. 
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VI.  SYSTEM  SIMULATION 


A.  SIMULATION  MODEL 

The  model  used  for  system  simulation  is  a  modified 
version  of  the  state- space  model  shown  in  Figure  4.1.  The  U 
and  V  gyro  errors  are  integrated,  and  the  result  nulled  to 
minimize  net  gyro  errors.  The  outer  gimbal  angle  is  calcu¬ 
lated  since  it  affects  the  plant  and  control  matrices,  but 
is  not  used  for  optimal  feedback.  The  simulation  model  has 
eleven  states,  and  is  shown  in  Figure  6.1.  The  plant  and 
control  matrices  for  the  simulation  model  are  given  in 
Figures  6 . 2  and  6.3. 

B.  WEIGHTING  MATRICES 

1.  Torque  Limits 

Each  axis  of  the  gyro  is  driven  by  a  torque  motor. 
The  amount  of  torque  delivered  by  the  motor  is  directly 
proportional  to  the  feedback  error  signal.  When  the  gyro 
errors  are  zero  and  the  sine  of  the  selected  gimbal  angle 
has  been  driven  to  null,  no  torque  is  generated. 

The  maximum  torques  which  can  be  supplied  to  each 

axis  are 

•  maximum  inner  axis  torque  83  oz-in 

•  maximum  middle  axis  torque  211  oz-in 

•  maximum  outer  axis  torque  Tg^g^^^  369  oz-in 

Up  to  14  percent  more  torque  is  available  dependent 
upon  the  particular  gimbal  angles.  This  additional  torque 
was  not  assumed  to  be  available  when  designing  the  state- 
space  system. 

2 .  State  Output  Weighting  Matrix 

The  optimal  control  cost  function  is  defined  as 

J  =  J  [2'^(t)Ri^(t)z(t)  +  u'^(t)R2(t)u(t)]dt 

The  output  measurement  vector  z(t)  is 
z(t)  =  [X2(t)  X3(t)  X5(t)  XgCt)  X3^o(^)  Xii(t)]^ 

^0 


Figure  6.3  Control  Matrix  for  the 
State  Space  Simulation  Model. 

The  output  vector  weighting  matrix  was  chosen  based 
on  data  provided  by  Draper  Laboratory.  The  output  vector 
varies  with  time  depending  on  gimbal  angles.  The  states 
which  comprise  the  output  vector  and  their  maximum  allowable 
values  are  shown  in  Table  II. 

TABLE  II 

OUTPUT  STATE  VECTOR  MAXIMUM  VALUES 


X2  U  Gyro 

X3  inner  gimbal  angle 
X5  V  Gyro 

xg  middle  gimbal  angle 

*10  ^  Gyro  error  integral 

Xj^j^  U  Gyro  error  integral 


300  quanta 
30  degrees 
300  quanta 
30  degrees 
1 
1 


The  maximum  value  of  300  quanta  listed  for  the  gyro 
angles  corresponds  to  an  error  of  0.278  milliradians .  This 


is  the  maximum  error  attained  with  the  current  Mark  6  gimbal 
model.  It  was  desired  to  allow  a  smaller  error  in  the 
state- space  model.  The  gyro  has  a  physical  stop  at  2048 
quanta,  or  1.9  milliradians .  If  the  error  reaches  this 
value  the  system  will  fail. 

The  inner  and  middle  gimbal  angle  maximum  values 
were  chosen  as  30  degrees.  This  prevents  the  product 
SIN(Aj^)SIN(Aj)  from  exceeding  0.5. 

The  maximum  value  of  the  integrals  of  the  U  and  V 
gyro  errors  was  chosen  arbitrarily  as  1.  This  limit  mini¬ 
mized  gyro  error  without  producing  excessive  input  ampli¬ 
tudes  . 


The  Rj^  matrix  in  terms  of  the  output  variables  is 


Rl  = 


0 

0 

0 

0 

0 


1/(X3), 


0 

0 


0 

0 

0 

0 


l/(x5)o' 

0 

0 

0 


0 

0 

0 


0 
0 
0 

0  l/(*10)o^ 


0 

0 

0 

0 

0 


0  0  l/(xii), 


Using  the  maximum  values  of  the  output  states  as 
given  in  Table  II,  The  output  cost  matrix  becomes 


11x10 

-5  0 

0 

0 

0 

0 

0 

3.65 

0 

0 

0 

0 

Rl  = 

0 

0 

l.llxlO‘5 

0 

0 

0 

0 

0 

0 

3.65 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

1 

3.  Control 

Input 

Weighting 

Matrix 

M _ 

The  control  input  weighting  matrix  is  a  third  order 
symmetric  matrix  with  the  inverse  of  the  square  of  the  allo¬ 
wable  torques,  given  previously,  on  the  diagonal.  The 
matrix  is  shown  below.  The  inputs  are  related  to  the 
torques  as  follows: 
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ir":s 


•  «!  =  inner  axis  torque  Tj 

•  U2  =  middle  axis  torque  Tm 

•  U3  =  outer  axis  torque  Tq 


H  = 


i/(Ti)2  0  0 

0  1/(T„)2  0 

_0  0  l/(To)^ 


Using  the  maximum  torque  values  given  previously, 


the  Ro  matrix  is: 


Ro  = 


1.45x10"^ 


2.25x10"^  0 

0  7.34x10’^ 


C .  TEST  PARAMETERS 

1.  Initial  Conditions 

The  initial  conditions  used  for  the  model  simulation 
were  provided  by  Draper  Laboratory.  This  particular  combi¬ 
nation  of  initial  conditions,  along  with  the  missile  motion, 
has  been  determined  to  be  the  ’’worst  case"  situation  for 
gyro  control. 

The  gimbal  angles  have  been  initialized  as  follows: 

•  stable  member  gimbal  angle  -  0  degrees 

•  inner  gimbal  angle  -  90  degrees 

•  middle  gimbal  angle  -  0  degrees 

•  outer  gimbal  angle  -  59.25  degrees 

The  system  is  started  from  rest,  with  all  gimbal  and 
angular  rates  zero.  The  initial  condition  vector  z(0)  is: 

Xj^(O)  =  0 
X2(0)  =  0 

X3(0)  =  90  degrees 

X4(0)  =  0 
X5(0)  =  0 

X6(0)  =  0 

X7(0)  =  0 
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0 


*8(0)  = 
x^(0)  =  59.25  degrees 
Xio(0)=  0 

xii(0)=  0 

2 .  Missile  Motion 

The  missile  motion  used  for  the  simulation  is  a 
pitch  rate  input.  The  input  is  applied  at  8  rad/sec^  to  a 
steady-state  value  of  1.571  rad/sec,  or  90  deg/sec.  The 
input  reaches  steady- state  after  0.19  seconds. 

D .  TEST  RESULTS 

The  system  was  initialized  using  the  values  above,  and 
the  pitch  input  applied.  The  tabulated  data  for  the  simula¬ 
tion  run  is  included  in  Appendix  D. 

Figure  6.4  shows  a  plot  of  U  and  V  gyro  error  as  a  func¬ 
tion  of  time.  The  switching  points  between  optimal  gain 
regions  are  shown  on  the  figure.  The  error  graphs  show  a 
transient  error  spike  when  the  optimal  gains  are  changed. 
The  amplitude  of  this  spike  can  be  made  arbitrarily  small  by 
reducing  the  size  of  the  optimal  control  regions.  If 
optimal  gains  were  calculated  and  applied  every  sample 
interval,  the  curve  would  show  no  such  fluctuations. 

A  comparision  between  the  errors  of  the  Draper  lab  Mark 
6  model  and  the  state-space  model  with  optimal  control 
region  gains  is  shown  in  Figures  6.5  and  6.6.  The  UGSGF 
error  signal.  Figure  6.5,  closely  approximates  the  Draper 
model  with  the  exception  of  the  switching  point  transients. 
The  error  damps  rapidly  after  the  optimal  gain  change,  main¬ 
taining  a  small  steady  state  error.  The  pitch  input  to  the 
U  gyro  has  a  gain  including  both  the  SIN(Aj.j) "'SIN(Aj )  term 
and  a  SIN(Ag)  term,  as  seen  in  Figure  4.1.  Since  both  the 
middle  and  stable  gimbal  angles  are  initially  zero,  the 
pitch  rate  does  not  affect  the  U  gyro  significantly  at  the 
start  of  the  simulation  run. 


The  VGSGF  error  signal  graph.  Figure  6.6,  shows  a  less 
pronounced  response  to  missile  motion  than  that  experienced 
by  the  Draper  model.  The  error  transients  again  damp  out 
quickly,  with  the  system  approaching  but  not  attaining  zero 
error  at  the  end  of  the  simulation  run.  The  V  gyro  shows  an 
immediate  response  to  missile  motion  since  the  gain  block 
contains  a  COS(Ag)  term,  allowing  the  pitch  rate  to  affect 
the  gyro  error  as  soon  as  the  middle  gimbal  angle  moves  away 
from  zero. 

The  maximum  gyro  errors  of  the  Draper  lab  model  and  the 
optimal  model,  neglecting  the  transient  error  spikes,  are 

•  U  gyro  error  Draper  lab  model  12  quanta 

•  U  gyro  error  optimal  model  10  quanta 

•  V  gyro  error  Draper  lab  model  94  quanta 

•  V  gyro  error  optimal  model  31  quanta 

The  maximum  transient  errors  of  the  optimal  model  are 

•  U  gyro  error  83  quanta 

•  V  gyro  error  63  quanta 

Figure  6.7  compares  the  inner  versus  middle  gimbal  angle 
of  the  Draper  model  and  the  state-space  model.  The 
state-space  model  exhibits  a  more  rapid  middle  gimbal  angle 
change  than  the  Draper  model.  The  angular  rate  of  the 
middle  gimbal  angle  could  be  slowed  down  by  varying  the 
maximum  allowed  value  of  the  angle  in  the  R2  weighting 
matrix.  A  slower  angular  rate  would  result  in  a  smaller 

middle  gimbal  angle,  and  the  SIN(Aj^)  term  in  the  gain  path 
would  reduce  the  effect  the  missile  motion  had  on  the  U  and 


V  gyro  errors.  A  trade-off  between  the  two  must  be  made, 
however,  since  the  input  signals  required  to  hold  the  middle 
angle  at  a  slower  rate  may  adversely  affect  the  gyro  errors. 

The  inner  gimbal  angles  of  both  systems  translate  at 
approximately  the  same  rate.  This  can  be  expected  since  the 
sine  of  the  middle  angle,  not  the  inner  angle,  is  being 
nulled  at  the  start  of  the  simulation.  The  inner  gimbal 
angle  is  not  being  controlled. 
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VII.  CONCLUSIONS  AND  RECOMMENDATIONS 


A.  CONCLUSIONS 

1.  Optimal  Design  Techniques 

It  has  been  shovm  that  an  optimal  feedback  gain 
controller  can  successfully  control  gyro  errors  and  prevent 
gimbal  lock.  The  unique,  non-linear  nature  of  the  Mark  6 
Gyro  requires  that  several  modifications  be  made  to  the 
linear  quadratic  problem  solution. 

As  the  gimbal  angles  vary,  the  internal  plant  gains 
vary.  Depending  on  the  gyro  orientation,  these  gains  can 
range  from  zero  to  one.  Care  must  be  taken  in  the  regions 
surrounding  zero  gain,  since  the  loop  is  effectively  broken 
at  this  point.  If  the  optimal  control  regions  chosen  are 
too  large,  the  instantaneous  switching  of  the  gain  from  zero 
to  a  finite  value  may  cause  large  transient  errors  from 
which  the  system  is  unable  to  recover.  Narrowing  the 
optimal  control  regions  near  the  zero  points  will  lessen  the 
impact  of  the  loop  suddenly  being  closed.  Increasing  the 
number  of  control  regions  would  also  increase  the  memory 
size  required  to  store  the  additional  gain  values.  There 
exists  a  trade-off  between  system  performance  and  the  amount 
of  control  hardware  required  to  implement  the  system. 

The  constantly  changing  gimbal  angles  also  lead  to 
numerous  set  point  shifts.  It  was  shown  in  chapter  five 
that  there  exists  an  optimal  control  input  which  drives  the 
state  to  the  desired  value  without  exceeding  the  input 
amplitude  limitations.  This  solution  requires  that  the 
inverse  of  the  closed  loop  transfer  function  exists  and  that 
the  number  of  controlled  states  is  equal  to  the  number  of 
inputs.  [Ref.  4:  p.  279].  If  either  of  these  conditions  is 
not  met,  a  set  point  axis  shift  must  be  used,  which  may 
cause  large  transient  errors.  Narrowing  the  optimal  control 


regions  in  these  areas  may  improve  system  performance 
Again,  additional  memory  space  would  be  required. 

B .  RECOMMENDATIONS 

1.  Improving  System  Performance 

The  gyro  controller  used  in  the  simulation  was 
designed  using  the  linear  quadratic  optimal  feedback  gain 
design  technique.  Since  the  technique  provides  optimal 
control  only  at  the  design  point,  a  region  controller  will 
not  provide  optimal  response  to  missile  motion  throughout 
the  region.  Changing  the  weighting  matrices  R^  and  R2  for  a 
particular  region  may  provide  improved  system  performance 
while  still  remaining  within  the  allowable  torque  limits. 
Since  the  maximum  allowable  value  for  the  controlled  gimbal 
angle  and  gyro  error  integrals  are  essentially  arbitrary, 
they  can  be  varied  and  the  resulting  system  performance 
analyzed  to  determine  if  the  error  in  that  region  can  be 
reduced. 

The  simulation  model  also  neglected  the  effects  of 
friction,  which  can  reduce  net  torque  to  the  axes  by  3  to  4 
oz-in.  The  friction  effects,  which  are  a  function  of  gimbal 
angular  rate,  may  produce  a  marked  decrease  in  system 
performance  in  areas  where  the  angles  are  changing  rapidly. 

Finally,  the  model  assumed  that  all  states  were 
available  for  feedback  and  that  there  was  no  noise  input. 
In  practical  applications,  this  assumption  is  invalid.  A 
Kalman  filter  must  be  designed  for  the  system  to  provide  an 
estimate  of  the  states  which  can  not  be  measured,  and  to 
optimize  system  performance  in  the  presence  of  both  process 
and  measurement  noise.  Harmonics  from  the  gyros  and  the 
torque  motors  may  have  an  effect  on  the  system,  along  with 
structural  noise  generated  during  missile  flight.  The  non¬ 
linearity  and  time  varying  nature  of  the  system  make  the 
design  of  a  filter  particularly  complex. 


APPENDIX  A 
DEFINITIONS 


TABLE  III 

VARIABLE  DEFINITIONS 

Ag  stable  element  gimbal  angle 

Aj  inner  gimbal  angle 

middle  gimbal  angle 
Aq  outer  gimbal  angle 

5  stable  member  inertial  rate 

i  inner  gimbal  inertial  rate 

A  middle  gimbal  inertial  rate 

6  outer  gimbal  inertial  rate 

Sg  sine  of  stable  element  angle 

Cg  cosine  of  stable  element  angle 

Sj  sine  of  inner  gimbal  angle 

Cj  cosine  if  inner  gimbal  angle 

Sj«j  sine  of  middle  gimbal  angle 

cosine  of  middle  gimbal  angle 
Sq  sine  of  outer  gimbal  angle 

Cq  cosine  of  outer  gimbal  angle 

UGSGF  U  gyro  error  signal  expressed  in  quanta 

VGSGF  V  gyro  error  signal  expressed  in  quanta 

IMU  Inertial  Measurement  Unit 

the  gyro  and  its  controller 


APPENDIX  B 
A 


1.  FOUR  GIMBAL  IMU  MODEL 

This  appendix  develops  the  equations  which  govern  the 
gyro  motion  due  to  inputs  from  missile  motion  and  torque 
motors.  A  block  diagram  of  the  plant  is  developed  from  the 
equations,  which  also  leads  to  the  state- space  model 
[Ref.  2:  pp.  2-7]. 

1.  Assumptions  and  Approximations 

This  analysis  includes  the  following  assumptions  and 
approximations : 

•  Spherical  inertias 

•  Small  torques  due  to  gyroscopic  effects 

2 .  Definitions 

Gimbal  motion  is  positive  in  a  clockwise  direction. 
The  transformation  from  an  inner  member  to  an  outer  member 
is  then  in  the  form: 


inner  member 
C 

outer  member 


COS 

-SIN 

0 

SIN 

COS 

0 

COS 

0 

1 

•  Standard  i,J,k  axes  will  be  used. 

•  X,  y  and  z  are  rate  components  on  the  i,  j  and  k  axes. 

•  p,  q  and  r  are  body,  or  missile,  motion  rates  on  the  i, 
j  and  k  axes  representing  pitch,  roll  and  yaw  respec¬ 
tively. 

•  A  positive  torque  T  applied  to  a  gimbal  causes  a  posi¬ 
tive,  clockwise  rotation. 

•  Ex,  Ey  and  Ez  are  the  gyro  errors  sensed  on  the  stable, 
or  inertial,  member. 


■a*  Ia/  J^' 


,»_W,*M  J|a  .ta 


I  a**  »*»  » 


3 .  Symbols 

•  S  -  Stable  member  gimbal  rate  resulting  from  applied 

torque 

*  i  -  Inner  member  gimbal  rate  resulting  from  applied 

torque 

*  li  -  Middle  member  gimbal  rate  resulting  from  applied 

torque 

• 

•  0  -  Outer  member  gimbal  rate  resulting  from  applied 

torque 

• 

*  As  -  Stable  member  gimbal  rate  resulting  from  relative 
motion  between  gimbals 

• 

•  Ai  -  Inner  member  gimbal  rate  resulting  from  relative 
motion  between  gimbals 

*  Am  -  Middle  member  gimbal  rate  resulting  from  relative 
motion  between  gimbauLs 

• 

•  Ao  -  Outer  member  gimbal  rate  resulting  from  relative 
motion  between  gimbals 

4.  Transformation  of  missile  motion  to  inertial  member 


a.  Base  motion 

Base  motion  Wb(5)  =  pi5  qjS  +  rkS 
referred  to  outer  gimbal:  (degree  of  freedom 

along  j4  and  j5) 


0  -So 


0(4) 


Co*p  -  So*r 


So"p  +  Co'-r 


Rates  along  Wby  do  not  couple  to  outer  gimbal. 
0  is  a  rate  applied  to  the  outer  gimbal  from  its  torque 
motor. 


r 


6 


Wox 

Co*p  - 

So*r 

Woy 

= 

0 

Woz 

So*p  + 

Co*r 

0(4) 

b.  Outer  gimbal  to  middle  gimbal  transformation 

Referred  to  middle  gimbal:  (degree  of  freedom 

along  the  i3  and  i4  axes) 


Wox 

Woy 

‘l  0  o' 

0  Cm  - Sm 

Co*p  -  So*r 

0 

Woz 

M(3) 

0  Sm  Cm 

So*p  +  Co*r 

Co*p  -  So*r 

=  Cm*0  -  Sm(So*p  +  Co*r) 

Sm*0  +  Cm(So*p  +  Co*r) 

Rates  along  Wox|m  do  not  couple  to  middle 
gimbal.  M  is  the  rate  of  middle  gimbal  applied  by  its 
torque  motor. 


Wmk 

"m 

Wmy 

= 

Cm*0  -  Sm*(So*p  -t 

Co*p ) 

Wmz 

Sm*0  +  Cm*(So*p  + 

Co*r ) 

M(3) 

c.  Middle  gimbal  to  inner  gimbal  transformation. 

Referred  to  inner  gimbal  (degree  of  freedom 
along  k2  and  k3  axes): 


1(2) 


Ci  -Si 
Si  Ci 


Cm*0  -  Sm*(So*p  +  Co*r) 
Sm*0  +  Cm*(So*p  +  Co*r) 


Ci*m  -  Si*”Cm*0  -  Sm*(So*p  Co*r)' 

=  Si*m  +  Ci*ECin*0  -  Sin*(So*p  +  Co*r)T 
Sm*0  +  Cm*(So*p  +  Co*r) 

Rates  along  Wmz|I  do  not  couple  into  inner 
gimbal.  I  is  rate  on  inner  gimbal  applied  by  torque  motor, 
therefore : 


Ci*M  -  Si*ECm*0  -  Sm*(So*p  +  Co*r)T 
Si*M  +  Ci*ECm*0  -  Sm*(So*p  +  Co*r)T 


I  1(2) 

d.  Inner  gimbal  to  stable  member  transformation. 

Referred  to  stable  member  (degree  of  freedom 
along  jl  and  J2  axes): 


S(l) 


Cs  0  -Ss 
0  10 
Ss  0  Cs 


Cs*Wix  -  Ss*Wiz 
=  Wiy 

Ss*Wix  +  Cs*Wiz 

Rates  along  Wiy|s  do  not  couple  across 
rate  on  stable  member  applied  by  motor,  therefore: 


E  is 


Wex 

Wey 

Wez 


Cs*[Ci*M  -  Si*[Cm*0  -  Sni*(So*p  +  Co*r)]]  -  Ss*I 
E 

Ss*[Ci*M  -  Si*[Cm*0  -  Sm*(So*p  +  Co*r)]]  +  Cs*I 


e.  Four  Gimbal  Block  Diagram. 

The  following  expressions  are  used  to  develop 
the  four  gimbal  IMU  block  diagram  shown  in  Figure  B.l: 


• 

=  ^iz^2  ■ 

• 

^0  '  '^0Y'j4  ■  '"^BY^S 
Ey  =  E  j 

=  '^EX^l 
"  '*^EZ^1 
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Torque  Motor 
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